/*
 * ESP32-P4 FL7703 LCD Driver - Simplified for LVGL
 */

#include "soc/soc_caps.h"

#if SOC_MIPI_DSI_SUPPORTED
#include "esp_check.h"
#include "esp_log.h"
#include "esp_lcd_panel_commands.h"
#include "esp_lcd_panel_interface.h"
#include "esp_lcd_panel_io.h"
#include "esp_lcd_mipi_dsi.h"
#include "esp_lcd_panel_vendor.h"
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "driver/gpio.h"
#include "include/esp_lcd_fl7703.h"

typedef struct
{
    esp_lcd_panel_io_handle_t io;
    int reset_gpio_num;
    uint8_t madctl_val;
    const fl7703_lcd_init_cmd_t *init_cmds;
    uint16_t init_cmds_size;
    struct
    {
        unsigned int reset_level : 1;
    } flags;
    // Original MIPI DPI panel functions
    esp_err_t (*del)(esp_lcd_panel_t *panel);
    esp_err_t (*init)(esp_lcd_panel_t *panel);
} fl7703_panel_t;

static const char *TAG = "fl7703";

static esp_err_t panel_fl7703_del(esp_lcd_panel_t *panel);
static esp_err_t panel_fl7703_init(esp_lcd_panel_t *panel);
static esp_err_t panel_fl7703_reset(esp_lcd_panel_t *panel);
static esp_err_t panel_fl7703_disp_on_off(esp_lcd_panel_t *panel, bool on_off);
static esp_err_t panel_fl7703_swap_xy(esp_lcd_panel_t *panel, bool swap_axes);
static esp_err_t panel_fl7703_mirror(esp_lcd_panel_t *panel, bool mirror_x, bool mirror_y);

esp_err_t esp_lcd_new_panel_fl7703(const esp_lcd_panel_io_handle_t io, const esp_lcd_panel_dev_config_t *panel_dev_config,
                                   esp_lcd_panel_handle_t *ret_panel)
{
    ESP_RETURN_ON_FALSE(io && panel_dev_config && ret_panel, ESP_ERR_INVALID_ARG, TAG, "invalid arguments");
    fl7703_vendor_config_t *vendor_config = (fl7703_vendor_config_t *)panel_dev_config->vendor_config;
    ESP_RETURN_ON_FALSE(vendor_config && vendor_config->mipi_config.dpi_config && vendor_config->mipi_config.mipi_dsi_bus, ESP_ERR_INVALID_ARG, TAG,
                        "invalid vendor config");

    esp_err_t ret = ESP_OK;
    fl7703_panel_t *fl7703 = (fl7703_panel_t *)calloc(1, sizeof(fl7703_panel_t));
    ESP_RETURN_ON_FALSE(fl7703, ESP_ERR_NO_MEM, TAG, "no mem for fl7703 panel");

    if (panel_dev_config->reset_gpio_num >= 0)
    {
        gpio_config_t io_conf = {
            .mode = GPIO_MODE_OUTPUT,
            .pin_bit_mask = 1ULL << panel_dev_config->reset_gpio_num,
        };
        ESP_GOTO_ON_ERROR(gpio_config(&io_conf), err, TAG, "configure GPIO for RST line failed");
    }

    // Set RGB/BGR order
    switch (panel_dev_config->color_space)
    {
    case LCD_RGB_ELEMENT_ORDER_RGB:
        fl7703->madctl_val = 0;
        break;
    case LCD_RGB_ELEMENT_ORDER_BGR:
        fl7703->madctl_val |= LCD_CMD_BGR_BIT;
        break;
    default:
        ESP_GOTO_ON_FALSE(false, ESP_ERR_NOT_SUPPORTED, err, TAG, "unsupported color space");
        break;
    }

    fl7703->io = io;
    fl7703->init_cmds = vendor_config->init_cmds;
    fl7703->init_cmds_size = vendor_config->init_cmds_size;
    fl7703->reset_gpio_num = panel_dev_config->reset_gpio_num;
    fl7703->flags.reset_level = panel_dev_config->flags.reset_active_high;

    // Create MIPI DPI panel
    esp_lcd_panel_handle_t panel_handle = NULL;
    ESP_GOTO_ON_ERROR(esp_lcd_new_panel_dpi(vendor_config->mipi_config.mipi_dsi_bus, vendor_config->mipi_config.dpi_config, &panel_handle), err, TAG,
                      "create MIPI DPI panel failed");

    // Save original functions and override
    fl7703->del = panel_handle->del;
    fl7703->init = panel_handle->init;
    panel_handle->del = panel_fl7703_del;
    panel_handle->init = panel_fl7703_init;
    panel_handle->reset = panel_fl7703_reset;
    panel_handle->disp_on_off = panel_fl7703_disp_on_off;
    panel_handle->swap_xy = panel_fl7703_swap_xy;
    panel_handle->mirror = panel_fl7703_mirror;
    panel_handle->user_data = fl7703;
    *ret_panel = panel_handle;

    ESP_LOGI(TAG, "FL7703 panel created successfully");
    return ESP_OK;

err:
    if (fl7703)
    {
        if (panel_dev_config->reset_gpio_num >= 0)
        {
            gpio_reset_pin(panel_dev_config->reset_gpio_num);
        }
        free(fl7703);
    }
    return ret;
}

// FL7703NI vendor specific initialization commands (exported as library API)
const fl7703_lcd_init_cmd_t fl7703ni_init_cmds[] = {
    {0xB9, (uint8_t[]){0xF1, 0x12, 0x87}, 3, 0},
    {0xB2, (uint8_t[]){0xB4, 0x03, 0x70}, 3, 0},
    {0xB3, (uint8_t[]){0x10, 0x10, 0x28, 0x28, 0x03, 0xFF, 0x00, 0x00, 0x00, 0x00}, 10, 0},
    {0xB4, (uint8_t[]){0x80}, 1, 0},
    {0xB5, (uint8_t[]){0x0A, 0x0A}, 2, 0},
    {0xB6, (uint8_t[]){0x8D, 0x8D}, 2, 0},
    {0xB8, (uint8_t[]){0x26, 0x22, 0xF0, 0x13}, 4, 0},
    // DSI configuration: 0x31 = 2-lane mode (optimized for stable operation)
    {0xBA, (uint8_t[]){0x31, 0x81, 0x05, 0xF9, 0x0E, 0x0E, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
                       0x44, 0x25, 0x00, 0x91, 0x0A, 0x00, 0x00, 0x01, 0x4F, 0x01, 0x00, 0x00, 0x37}, 27, 0},
    {0xBC, (uint8_t[]){0x47}, 1, 0},
    {0xBF, (uint8_t[]){0x02, 0x10, 0x00, 0x80, 0x04}, 5, 0},
    {0xC0, (uint8_t[]){0x73, 0x73, 0x50, 0x50, 0x00, 0x00, 0x12, 0x73, 0x00}, 9, 0},
    {0xC1, (uint8_t[]){0x36, 0x00, 0x32, 0x32, 0x77, 0xE1, 0x77, 0x77, 0xCC, 0xCC, 0xFF, 0xFF, 0x11, 0x11,
                       0x00, 0x00, 0x32}, 17, 0},
    {0xC7, (uint8_t[]){0x10, 0x00, 0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0xED, 0xC5, 0x00, 0xA5}, 12, 0},
    {0xC8, (uint8_t[]){0x10, 0x40, 0x1E, 0x03}, 4, 0},
    {0xCC, (uint8_t[]){0x0B}, 1, 0},
    {0xE0, (uint8_t[]){0x00, 0x0A, 0x0F, 0x2A, 0x33, 0x3F, 0x44, 0x39, 0x06, 0x0C, 0x0E, 0x14, 0x15, 0x13,
                       0x15, 0x10, 0x18, 0x00, 0x0A, 0x0F, 0x2A, 0x33, 0x3F, 0x44, 0x39, 0x06, 0x0C, 0x0E, 
                       0x14, 0x15, 0x13, 0x15, 0x10, 0x18}, 34, 0},
    {0xE1, (uint8_t[]){0x11, 0x11, 0x91, 0x00, 0x00, 0x00, 0x00}, 7, 0},
    {0xE3, (uint8_t[]){0x07, 0x07, 0x0B, 0x0B, 0x0B, 0x0B, 0x00, 0x00, 0x00, 0x00, 0xFF, 0x04, 0xC0, 0x10}, 14, 0},
    {0xE9, (uint8_t[]){0xC8, 0x10, 0x0A, 0x00, 0x00, 0x80, 0x81, 0x12, 0x31, 0x23, 0x4F, 0x86, 0xA0, 0x00, 
                       0x47, 0x08, 0x00, 0x00, 0x0C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0C, 0x00, 0x00, 0x00, 
                       0x98, 0x02, 0x8B, 0xAF, 0x46, 0x02, 0x88, 0x88, 0x88, 0x88, 0x88, 0x98, 0x13, 0x8B, 
                       0xAF, 0x57, 0x13, 0x88, 0x88, 0x88, 0x88, 0x88, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
                       0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, 63, 0},
    {0xEA, (uint8_t[]){0x97, 0x0C, 0x09, 0x09, 0x09, 0x78, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9F, 0x31, 
                       0x8B, 0xA8, 0x31, 0x75, 0x88, 0x88, 0x88, 0x88, 0x88, 0x9F, 0x20, 0x8B, 0xA8, 0x20, 
                       0x64, 0x88, 0x88, 0x88, 0x88, 0x88, 0x23, 0x00, 0x00, 0x02, 0x71, 0x00, 0x00, 0x00, 
                       0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x80, 
                       0x81, 0x00, 0x00, 0x00, 0x00}, 61, 0},
    {0xEF, (uint8_t[]){0xFF, 0xFF, 0x01}, 3, 0},
    {0x11, (uint8_t[]){0x00}, 0, 250},  // Sleep Out
    {0x29, (uint8_t[]){0x00}, 0, 50},   // Display On
};

const uint16_t fl7703ni_init_cmds_size = sizeof(fl7703ni_init_cmds) / sizeof(fl7703_lcd_init_cmd_t);

void fl7703_get_default_init_config(const fl7703_lcd_init_cmd_t **init_cmds, uint16_t *init_cmds_size)
{
    if (init_cmds) {
        *init_cmds = fl7703ni_init_cmds;
    }
    if (init_cmds_size) {
        *init_cmds_size = fl7703ni_init_cmds_size;
    }
}

static esp_err_t panel_fl7703_del(esp_lcd_panel_t *panel)
{
    fl7703_panel_t *fl7703 = (fl7703_panel_t *)panel->user_data;

    if (fl7703->reset_gpio_num >= 0)
    {
        gpio_reset_pin(fl7703->reset_gpio_num);
    }
    fl7703->del(panel);
    free(fl7703);
    return ESP_OK;
}

static esp_err_t panel_fl7703_init(esp_lcd_panel_t *panel)
{
    fl7703_panel_t *fl7703 = (fl7703_panel_t *)panel->user_data;
    esp_lcd_panel_io_handle_t io = fl7703->io;
    const fl7703_lcd_init_cmd_t *init_cmds = fl7703->init_cmds;
    uint16_t init_cmds_size = fl7703->init_cmds_size;

    // Validate initialization commands are provided
    ESP_RETURN_ON_FALSE(init_cmds && init_cmds_size > 0, ESP_ERR_INVALID_ARG, TAG, 
                       "No initialization commands provided");

    // Send initialization commands
    for (int i = 0; i < init_cmds_size; i++)
    {
        ESP_RETURN_ON_ERROR(esp_lcd_panel_io_tx_param(io, init_cmds[i].cmd, init_cmds[i].data, init_cmds[i].data_bytes),
                           TAG, "send init command failed");
        if (init_cmds[i].delay_ms > 0) {
            vTaskDelay(pdMS_TO_TICKS(init_cmds[i].delay_ms));
        }
    }

    // Initialize MIPI DPI panel
    ESP_RETURN_ON_ERROR(fl7703->init(panel), TAG, "init MIPI DPI panel failed");
    
    ESP_LOGI(TAG, "FL7703 panel initialization completed");
    return ESP_OK;
}

static esp_err_t panel_fl7703_reset(esp_lcd_panel_t *panel)
{
    fl7703_panel_t *fl7703 = (fl7703_panel_t *)panel->user_data;
    esp_lcd_panel_io_handle_t io = fl7703->io;

    if (fl7703->reset_gpio_num >= 0)
    {
        gpio_set_level(fl7703->reset_gpio_num, !fl7703->flags.reset_level);
        vTaskDelay(pdMS_TO_TICKS(5));
        gpio_set_level(fl7703->reset_gpio_num, fl7703->flags.reset_level);
        vTaskDelay(pdMS_TO_TICKS(10));
        gpio_set_level(fl7703->reset_gpio_num, !fl7703->flags.reset_level);
        vTaskDelay(pdMS_TO_TICKS(120));
    }
    else if (io)
    {
        ESP_RETURN_ON_ERROR(esp_lcd_panel_io_tx_param(io, LCD_CMD_SWRESET, NULL, 0), TAG, "software reset failed");
        vTaskDelay(pdMS_TO_TICKS(120));
    }
    return ESP_OK;
}

static esp_err_t panel_fl7703_disp_on_off(esp_lcd_panel_t *panel, bool on_off)
{
    fl7703_panel_t *fl7703 = (fl7703_panel_t *)panel->user_data;
    esp_lcd_panel_io_handle_t io = fl7703->io;
    int command = on_off ? LCD_CMD_DISPON : LCD_CMD_DISPOFF;
    ESP_RETURN_ON_ERROR(esp_lcd_panel_io_tx_param(io, command, NULL, 0), TAG, "display on/off failed");
    return ESP_OK;
}

static esp_err_t panel_fl7703_swap_xy(esp_lcd_panel_t *panel, bool swap_axes)
{
    // FL7703驱动不支持XY轴交换，返回成功但忽略操作
    ESP_LOGD(TAG, "swap_xy operation ignored (not supported by FL7703)");
    return ESP_OK;
}

static esp_err_t panel_fl7703_mirror(esp_lcd_panel_t *panel, bool mirror_x, bool mirror_y)
{
    // FL7703驱动不支持镜像操作，返回成功但忽略操作
    // 这样可以避免LVGL初始化时的错误信息
    ESP_LOGD(TAG, "mirror operation ignored (not supported by FL7703)");
    return ESP_OK;
}

static esp_err_t panel_fl7703_invert_color(esp_lcd_panel_t *panel, bool invert_color_data)
{
    fl7703_panel_t *fl7703 = (fl7703_panel_t *)panel->user_data;
    esp_lcd_panel_io_handle_t io = fl7703->io;
    int command = invert_color_data ? LCD_CMD_INVON : LCD_CMD_INVOFF;
    ESP_RETURN_ON_ERROR(esp_lcd_panel_io_tx_param(io, command, NULL, 0), TAG, "invert color failed");
    return ESP_OK;
}

static esp_err_t panel_fl7703_set_gap(esp_lcd_panel_t *panel, int x_gap, int y_gap)
{
    // FL7703驱动不支持设置gap，返回成功但忽略操作
    // 这样可以避免LVGL初始化时的错误信息
    ESP_LOGD(TAG, "set_gap operation ignored (not supported by FL7703)");
    return ESP_OK;
}

#endif 